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ABSTRACT 

In  this  report  mathematical  models  (2-D  Azimuth  and  Elevation  Planes)  for  multi-party 
engagement  kinematics  are  derived  suitable  for  developing,  implementing  and  testing  modern 
missile  guidance  systems.  The  models  developed  here  are  suitable  for  both  conventional  and 
more  advanced  optimal  intelligent  guidance  schemes  including  those  that  arise  out  of  the 
differential  game  theory.  These  models  accommodate  changes  in  vehicle  body  attitude  and  other 
non-linear  effects  such  as  limits  on  lateral  acceleration  and  aerodynamic  forces. 
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Integrated  Navigation,  Guidance,  and  Control  of 
Missile  Systems:  2-D  Dynamic  Models 


Executive  Summary 


In  the  past,  linear  kinematics  models  have  been  used  for  development  and  analysis  of 
guidance  laws  for  missile/  target  engagements.  These  models  were  developed  in  fixed  axis 
systems  under  the  assumption  that  the  engagement  trajectory  does  not  vary  significantly 
from  the  collision  course  geometry.  While  these  models  take  into  account  autopilot  lags 
and  acceleration  limits,  the  guidance  commands  are  applied  in  fixed  axis,  and  ignore  the 
fact  that  the  missile/ target  attitude  may  change  significantly  during  engagement.  This 
latter  fact  is  particularly  relevant  in  cases  of  engagements  where  the  target  implements 
evasive  manoeuvres,  resulting  in  large  variations  of  the  engagement  trajectory  from  that  of 
the  collision  course.  The  linearised  models  are  convenient  for  deriving  guidance  laws  (in 
analytical  form),  however,  the  study  of  their  performance  characteristics  still  requires  a 
non-linear  model  that  incorporates  changes  in  body  attitudes  and  implements  guidance 
commands  in  body  axis  rather  than  the  fixed  axis.  In  this  report,  azimuth  and  elevation 
plane  mathematical  models  for  multi-party  engagement  kinematics  are  derived  suitable 
for  developing,  implementing  and  testing  modern  missile  guidance  systems.  The  models 
developed  here  are  suitable  for  both  conventional  and  more  advanced  optimal  intelligent 
guidance,  particularly  those  based  on  the  'game  theory'  guidance  techniques.  These 
models  accommodate  changes  in  vehicle  body  attitude  and  other  non-linear  effects,  such 
as,  limits  on  lateral  acceleration  and  aerodynamic  forces.  The  models  presented  in  this 
report  will  be  found  suitable  for  computer  simulation  and  analysis  of  multi-party 
engagements. 
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Nomenclature 

number  of  interceptors  (pursuers)  and  targets  (evaders) 
respectively. 

are  x ,  y,  z-positions  respectively  of  vehicle  i  in  fixed  axis, 
are  x,  y,  z- velocities  respectively  of  vehicle  i  in  fixed  axis, 
are  x,  y,  z-accelerations  respectively  of  vehicle  i  in  fixed  axis, 
are  x,  y,  z-positions  respectively  of  vehicle  j  w.r.t  i  in  fixed  axis, 
are  x,  y,  z-velocities  respectively  of  vehicle  j  w.r.t  i  in  fixed  axis, 
are  x,  y,  z-accelerations  respectively  of  vehicle  j  w.r.t  i  in  fixed 
axis. 

are  x  ,y-position,  velocity  and  acceleration  vectors  of  vehicle  i  in 
fixed  axis. 

are  x,  y-  relative  position,  velocity  and  acceleration  vectors  of  vehicle 
j  w.r.t  i  in  fixed  axis. 

are  x,  z-position,  velocity  and  acceleration  vectors  of  vehicle  i  in 
fixed  axis. 

are  x,  z-  relative  position,  velocity  and  acceleration  vectors  of  vehicle 
j  w.r.t  i  in  fixed  axis. 

separation  range  of  vehicle  j  w.r.t  i  in  fixed  axis, 
closing  velocity  of  vehicle  j  w.r.t  i  in  fixed  axis, 
are  line-of-sight  angle  (LOS)  of  vehicle  j  w.r.t  i  in  yaw  and  pitch 
planes  respectively. 

x,  y,  z-accelerations  respectively  achieved  by  vehicle  i  in  body  axis. 

x,  y,  z-accelerations  respectively  demanded  by  vehicle  i  in  body 
axis. 

is  the  achieved  missile  acceleration  vector  in  body  axis. 

is  the  demanded  missile  acceleration  vector  in  body  axis. 

are  yaw  and  pitch  body  (Euler)  angles  respectively  of  the  ith  vehicle 
w.r.t  the  fixed  axis. 

is  the  transformation  matrix  from  body  axis  to  fixed  axis, 
is  the  velocity  of  vehicle  i. 

autopilot's  longitudinal  time-constant  for  vehicle  i. 
autopilot's  lateral  time-constant  for  vehicle  i. 
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In  the  past  [1, 2]  linear  kinematics  models  have  been  used  for  development  and  analysis  of 
guidance  laws  for  missile/  target  engagements.  These  models  were  developed  in  fixed  axis 
under  the  assumption  that  the  engagement  trajectory  does  not  vary  significantly  from  the 
collision  course  geometry.  While  these  models  take  into  account  autopilot  lags  and 
acceleration  limits,  the  guidance  commands  are  applied  in  fixed  axis,  and  ignore  the  fact  that 
the  missile/  target  attitude  may  change  significantly  during  engagement.  This  latter  fact  is 
particularly  relevant  in  cases  of  engagements  where  the  target  implements  evasive 
manoeuvres,  resulting  in  large  variations  of  the  engagement  trajectory  from  that  of  the 
collision  course  [3].  The  linearised  models  are  convenient  for  deriving  guidance  laws  (in 
analytical  form),  however,  the  study  of  their  performance  characteristics  still  requires  a  non¬ 
linear  model  that  incorporates  changes  in  body  attitudes  and  implements  guidance 
commands  in  body  axis  rather  than  the  fixed  axis. 

In  this  report,  mathematical  models  for  multi-party  engagement  kinematics  are  derived 
suitable  for  developing,  implementing  and  testing  modern  missile  guidance  systems.  The 
models  developed  here  are  suitable  for  both  conventional  and  more  advanced  optimal 
intelligent  guidance,  particularly  those  based  on  the  'game  theory'  guidance  techniques.  The 
models  accommodate  changes  in  vehicle  body  attitude  and  other  non-linear  effects  such  as 
limits  on  lateral  acceleration  and  aerodynamic  forces.  Body  incidence  is  assumed  to  be  small 
and  is  neglected.  The  models  presented  in  this  report  will  be  found  suitable  for  computer 
simulation  and  analysis  of  multi-party  engagements.  Sections  2-4  of  this  report  considers  in 
some  detail  the  derivation  of  engagement  dynamics  in  azimuth  (Az)  plane.  Subsequent 
sections  consider  the  engagement  dynamics  in  elevation  (El)  plane  and  perhaps  more  relevant 
to  trajectories  that  are  typical  of  glide  vehicles. 


2.  Development  of  Azimuth  Plane  Engagement 

Kinematics  Model 

2.1  Translational  Kinematics  for  Multi-Vehicle  Engagement 

A  typical  2-vehicle  engagement  geometry  is  shown  in  Figure  1,  we  define  the  following 
variables: 

(xj  ,yj ) :  are  x  ,y-positions  respectively  of  vehicle  i  in  fixed  axis. 

(u ; ,  V; ) :  are  x,  y- velocities  respectively  of  vehicle  i  in  fixed  axis. 

(ax.  ,ay.  ]:  are  x,  y-accelerations  respectively  of  vehicle  i  in  fixed  axis. 

The  above  variables  are  functions  of  time  t .  Then  the  motion  of  vehicle  for  n  interceptors  and 
m  targets  (i :  i  =  1,2,...,  n  +  m)  (i.e.  position,  velocity  and  acceleration)  in  fixed  (e.g.  inertial)  axis 
is  given  by  the  following  differential  equations: 

-^;xi  =ui  (21) 

at 
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d 

(2.2) 

-y,=y, 

cs 

II 

sT 

’ 

(2.3) 

< 

II 

■< 

(2.4) 

For  multiple  vehicles  i,  j  engagement,  we  define  the  relative  variables  (states)  for 
(i :  i  =  1,2,,,.,  n;  j  =  1,2,.,.,  m;  j  ^  i)  as  follows: 
x  jj  =  x  j  -  X;  :  x-position  of  vehicle  j  w.r.t  i  in  fixed  axis, 
y  j  j  =  y  j  —  y  i  :  y-position  of  vehicle  j  w.r.t  i  in  fixed  axis. 

Ujj  =  u  j  -  u ;  :  x-velocity  of  vehicle  j  w.r.t  i  in  fixed  axis. 

Vjj  =  V  j  -  Vj  :  y-velocity  of  vehicle  j  w.r.t  i  in  fixed  axis. 
a„..  =  a„.  -av.  :  x-acceleration  of  vehicle  i  w.r.t  i  in  fixed  axis. 
ay  ji  =  ay .  -ayi  :  y-acceleration  of  vehicle  j  w.r.t  i  in  fixed  axis. 

2.1.1  Vector/Matrix  Representation 

We  can  write  equations  (2.1)-(2.4),  in  vector  notation  as: 

N,=»,  (2-5) 

ASi=a,  P.6) 

Where: 

x  j  =  [x  j  y  i  ]T  :  is  the  position  vector  of  vehicle  i  in  fixed  axis. 

Uj  =  [u ;  Vj  ]T  :  is  the  velocity  vector  of  vehicle  i  in  fixed  axis. 

a;  =  [ax.  ay.  J7  :  is  the  target  acceleration  vector  of  vehicle  i  in  fixed  axis. 


Similarly,  we  can  write  the  relative  kinematics  vector  equations  as: 

d 

df-ji  ~-ji 


dt  “ji  “j  5i 


(2.7) 

(2.8) 


Where: 

-ji  =  [x ji  y  ji  ]T  :  position  vector  of  vehicle  j  w.r.t  i  in  fixed  axis. 

u  jj  =  [u  jj  Vjj  ]T  :  velocity  vector  of  vehicle  j  w.r.t  i  in  fixed  axis. 

a —  |a„ ..  av..  =  a;  -  a,  :  acceleration  vector  of  vehicle  j  w.r.t  i  in  fixed  axis, 

-ji  l  xji  yji  j  -j  -i  ’ 
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Note:  The  above  formulation  admits  consideration  of  engagement  where  one  particular 
vehicle  (interceptor)  is  fired  at  another  single  vehicle  (target).  In  other  words  we  consider  one- 
against-one  in  a  scenario  consisting  of  many  vehicles.  This  consideration  can  be  extended  to 
one-against-many  if,  for  example,  i  takes  on  a  single  value  and  j  is  allowed  to  take  on  a 
number  of  different  values. 


2.2  Constructing  Relative  Sightline  (LOS)  Angles  and  Rates  -  (Rotational 
Kinematics) 

The  separation  range  R ^  between  vehicles  j  w.r.t  i  is  given  by: 


The  range  rate  R  j;  is  given  by: 

AR  _r  xjiuji+yjivji  feji1  sji) 
dt  J1  J1 


(2.10) 


The  Closing  Velocity  Vc„  is  given  by: 


(2.11) 


The  sightline  angle  A, jj  of  j  w.r.t  i  is  given  by: 
tan  A.jj  =  — 


Differentiating  both  sides  of  the  equation  and  simplifying,  we  get: 

A, yjixji  yjifji  xjivii ~yjiuji 

dt  R„2  R„2  R  2  T»  2 


V  Rjl 


J1 


R 


Ji 


Where: 

'  0  1 
-1  0 


[J]= 


(2.12) 


(2.13) 


Note  that  an  approximation  to  (2.13)  is  sometimes  used,  although  not  recommended  for 
simulation  purposes,  based  on  the  assumptions  that  the  engagement  geometry  does  not 
deviate  significantly  from  the  collision  course;  in  this  case: 
xji  ~  Rji  =  vcjiTgo  i  xji  »  Rji  =  -Vc.. ;  Tg0  =  (tf  - 1) : is  the  time-to-go. 


Substituting  this  in  equation  (2.13)  gives  us: 
f  .  ^ 


Li  =  — 

J  Vc- 

cJi 


yjj  ,  yji 


lgo 


‘go  J 


(2.14) 
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The  measurements  Ajj  obtained  from  the  seeker  that  are  used  to  construct  the  guidance 
commands  are  given  by: 


Ajj  —  A»jj  +  AA  jj 


(2.15) 


Where: 

AAjj  :  seeker  LOS  rate  measurement  error. 

The  above  relationships  (2.9)-(2.15)  will  also  be  referred  to  as  the  seeker  model. 

2.3  Vehicle  Navigation  Model 

Let  us  define  the  following: 

a  :  x-acceleration  achieved  by  vehicle  i  in  its  body  axis, 
a*’  :  y-acceleration  achieved  by  vehicle  i  in  its  body  axis. 


The  transformation  from  fixed  to  body  axis  is  given  by  (see  Figure  2): 


COSV|/j 

sin\|/j 

a*i’ 

.It 

»l 

axi 

—  sin  v|/j 

COSV|/j 

_ayi  _ 

L 

f  Ji 

_ayi_ 

(2.16) 


In  vector/ matrix  notation  this  equation  may  be  written  as: 


*i 

(2.17) 

Si  =[t£],  af 

(2.18) 

Where: 

\|/j :  is  the  yaw  (Euler)  angle  of  the  ith  vehicle  w.r.t  the  fixed  axis.  It  is  assumed  that  the  body 
orientation  vj/j  changes  during  the  engagement. 
lT 

:  is  acceleration  vector  of  vehicle  i  in  its  body  axis. 


ab=|>  ab 
-1  L  xi  yi 

kl  =  [Tb  ].  =  [Tb  ].  : is  the  transformation  matrix  from  body  axis  to  fixed 

[4  - 


axis. 


cosv|/j  -smv|/j 
sinij/j  cosi)/} 


:  is  the  (direction  cosine)  transformation  matrix  from  body  to  fixed 


axis. 


The  vehicle  velocity  is  given  by: 

Vi=(ui2  +  Vi2)2  =(uiTUj)2 


(2.19) 
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Now  the  flight  path  angle  (=angle  that  the  velocity  vector  makes  with  the  fixed  axis)  is  given 
by: 

Vi  (2.20) 


Where: 


Pi  =  tan  1  —  :  is  the  azimuth  body  incidence  (side-slip  angle),  {  ub ,  vb  }  are  body  axis 


vub  y 

velocities  (Figure  Al.l). 


Differentiating  both  sides  of  equation  (2.20)  and  simplifying  we  get: 
ViUj  Vjiii  uiayi  -  viaxi  UiT[j]ai 


Vi  -  Pi 


Vi2  V}2 


VF 


Vi' 


(2.21) 


Assuming  p} ,  Pj  remain  small  ( ub  »  vb ;  see  also  Appendix  A),  then  we  may  write: 

(2.22) 


d  VjU;  Vjiii  uiayj  -  Viax.  UjT[j]aj 

"Vi 


dt  Yl 


V- 2  V- 2 

T  i  '  i 


Vi' 


Vi' 


2.4  Vehicle  Autopilot  Dynamics 


Assuming  a  first  order  lag  for  the  autopilot,  we  may  write  for  vehicle  i: 


—  ab 
dt  xi 


—  a  =  — x v.  a  +  ty.  a 


H  Xi  A1  Xi 


ld 


—  ab  =  — x .. .  ab  +  Ty.  ab 
dt  yi  yi  yi  yi  yid 


(2.23) 

(2.24) 


In  vector /matrix  notation  equations  (2.23),  (2.24)  may  be  written  as: 

A.M-A.kDhR 


(2.25) 


Where: 

tx.  :  Vehicle  i  autopilot's  longitudinal  time-constant. 
Ty.  :  Vehicle  i  autopilot's  lateral  time-constant. 


[Ai]  = 


Tx.  0 

xl 

0  Ty. 


a  b  :  x-acceleration  demanded  by  vehicle  i  in  its  body  axis. 


*d 


ab  :  y-acceleration  demanded  by  vehicle  i  in  its  body  axis. 
yid 


ab  ab 
xid  yid 


:  is  the  demanded  missile  acceleration  (command  input)  vector  in  body 


axis. 
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Remarks:  Detailed  consideration  of  the  effects  of  the  aerodynamic  forces  is  contained  in 


Appendix  A.  Generally,  the  longitudinal  acceleration  a 1 


5T}  -  SDj 


of  a  missile  is  not 


'd 


Ill: 


varied  in  response  to  the  guidance  commands  and  may  be  assumed  to  be  zero.  However,  the 

I'J'  _  J)  ) 

•  «  b  -  - -  will  change  due  to  changes  in  flight  conditions  and  needs  to  be 

m 

included  in  the  simulation  model;  this  is  shown  in  the  block  diagram  Figure  6.  The  limits  on 


nominal  values:  aD  = 


the  lateral  acceleration  can  be  implemented  as: 


yid 


<  p  aymax  (see  Appendix  A). 


3.  Guidance  Laws 


3.1  Proportional  Navigation  (PN)  Guidance 

There  are  at  least  three  versions  of  PN  guidance  laws  that  the  author  is  aware  of;  these  are 
(for  vehicle  i  -  the  pursuer  against  an  intercept  (target)  vehicle  j  -  the  evader): 

3.1.1.  Version  1  (PN-1): 

This  implementation  is  based  on  the  principle  that  the  demanded  body  rate  of  the  attacker 
i  is  proportional  to  LOS  rate  to  the  target  j  (see  Figure  1);  that  is: 

¥id=Nlji  (3.1) 


Where:  N :  is  the  navigation  constant.  Thus  the  demanded  attacker  lateral  acceleration  is  given 
by: 


ay;d  =V,V,d=NV,Xj, 

ab  _  5Ti  ~  5pi 

Xid  m; 


(3.2) 

(3.3) 


3.1.2.  Version  2  (PN-2): 

This  implementation  is  based  on  the  principle  that  the  demanded  lateral  acceleration  of 
the  attacker  i  is  proportional  to  the  acceleration  perpendicular  (normal)  to  the  LOS  rate  to  the 
target  j.  Now  the  acceleration  normal  to  the  LOS  is  given  by: 

(3-4) 

ab  =Nan..  =NVC..  (3.5) 

yin  nJi  CJ1  JI  v  ’ 


b  STj-SD; 

d  — 

x*d  mj 


(3.6) 


Where: 
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Vc„  =  -Rjj  :  is  the  'closing  velocity'  between  the  attacker  and  the  target. 

an ..  :  is  the  acceleration  normal  to  the  LOS. 

nji 

3.1.3.  Version  3  (PN-3): 

This  type  of  guidance  law  is  similar  to  version  2  except  that  the  normal  LOS  acceleration  is 
resolved  along  the  lateral  direction  to  the  attacker  body  axis  first  before  applying  the 
proportionality  principal.  Thus,  we  have: 

an p  =  Vc jj  L  jj  (3.7) 

giving  us  the  guidance  commands: 

ay.^  =  Nanjj  cos(yj  —  A,jij=NVc„  cos(v|/i  — 

„b  STi-SD; 

d  —  - 

xid  m; 

3.2  Augmented  Proportional  Navigation  (APN)  Guidance 

Finally,  a  variation  of  the  PN  guidance  law  is  the  APN  that  can  be  implemented  as 
follows: 

a?d  =(PNG)+N'[Tfb].aj  (3.10) 


(3.8) 

(3.9) 


Where: 

N ' :  is  the  (target)  acceleration  navigation  constant 

(PNG): is  the  proportional  navigation  guidance  law  given  in  (3.1)-(3.7) 

Remarks 

•  Seeker  errors  can  be  introduced  by  replacing  £jj  by  £  jj  in  the  guidance  laws  above. 

•  In  certain  engagement  geometries  Vc  ..  ,cos(..),sin(..)  and  terms  in  the  above  equations 

may  become  zero  prior  to  termination  of  the  engagements,  particularly  for  manoeuvring 
targets,  and  it  may  become  necessary  to  apply  additional  disturbances  to  achieve 
successful  intercept. 


4.  Overall  Azimuth  Plane  State  Space  Model 


The  overall  non-linear  state  space  model  (e.g.  for  APN  guidance)  that  can  be  used  for 
sensitivity  studies  and  for  non-linear  or  Monte-Carlo  analysis  is  given  below: 

d  (4-1) 


dt“ji  “ji 


d  Lfl  h  Lfl  b 
dt  -ji  “  lTb  Jj  -j  lTb  ji  -i 


(4.2) 
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dt  x-'x- 

-J1  -J1 

aL  ={(PNG)+N'tr,bJ1sj) 


N_r=[-A,R+[A,H 

d 


dt 


Vi  =  Vi 


UiT[j]ai 


(4.3) 

(4.4) 

(4.5) 

(4.6) 


The  overall  state  space  model  that  can  be  implemented  on  the  computer  is  given  in  Table  4.1, 
and  the  block-diagram  is  shown  in  Figure  6. 


5.  Extension  to  Elevation  Plane  Engagement  Model 


The  axis  transformation  diagram  is  shown  in  Figure  4.  We  shall  point  out  the  fact  that  the 
order  of  rotation  is  in  the  order  (yaw,  pitch  and  roll),  i.e.  (\p  — >  0  — >•  <j>) .  Of  course  for  a  2-D 
yaw-pitch  decoupled  model  (|)  =  0 ,  however,  we  shall  continue  to  follow  this  convention  for 
the  derivation  given  in  this  report.  Figures  2  and  5  depict  the  yaw  and  pitch  transformation 
diagrams  separately.  It  will  be  noted,  therefore,  the  key  differences  in  the  yaw  and  the  pitch 
derivation  is  the  transformation  matrix,  and  the  steady-state  aerodynamic  forces  acting  in  the 
two  planes. 


5.1  Translational  Kinematics  for  Multi-Vehicle  Engagement 

The  development  of  the  elevation  (El)  plane  model  follows  closely  the  methodology  used 
in  the  development  of  the  Az  model;  we  define  the  following  variables: 

(x ; ,  z; ) :  are  x  ,z-positions  respectively  of  vehicle  i  in  fixed  axis. 

(u ; ,  w ; ) :  are  x,  z- velocities  respectively  of  vehicle  i  in  fixed  axis. 

(ax.  ,az.  J:  are  x,  z-accelerations  respectively  of  vehicle  i  in  fixed  axis. 


The  motion  of  vehicle  for  n  interceptors  and  m  targets  (i :  i  =  1,2,...,  n  +  m)  (i.e.  position, 
velocity  and  acceleration)  in  fixed  (e.g.  inertial)  axis  is  given  by  the  following  differential 
equations: 


dt 

d^ 

dt 

d^ 

dt 


ui  =axi 


—  w :  =a7. 

dt  1  Zl 


(5.1) 

(5.2) 

(5.3) 

(5.4) 
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For  multiple  vehicles  i,  j  engagement,  we  define  the  relative  variables  (states)  for 
(i :  i  =  1,2,.,.,  n;  j  =  1,2,...,  m)  as  follows: 
x  j;  =  x  j  -  X;  :  x-position  of  vehicle  j  w.r.t  i  in  fixed  axis. 

Zjj  =  z  j  -  zj  :  z-position  of  vehicle  j  w.r.t  i  in  fixed  axis. 

Ujj  =  u j  -  uj  :  x-velocity  of  vehicle  j  w.r.t  i  in  fixed  axis, 
w jj  =  w  j  -  w  j  :  z-velocity  of  vehicle  j  w.r.t  i  in  fixed  axis. 
a„..  =a„.  -aY.  :  x-acceleration  of  vehicle  i  w.r.t  i  in  fixed  axis. 
aZj.  =  aZj  -  azi  :  z-acceleration  of  vehicle  j  w.r.t  i  in  fixed  axis. 


5.1.1.  Vector/Matrix  Representation 

We  can  write  equations  (5.1)-(5.4),  in  vector  notation  as: 

d 

dt  -i 
d 


(5.5) 

(5.6) 


Similarly,  we  can  write  the  relative  kinematics  vector  equations  as: 

d 

dr'ii^ 

d 

- v  ••  =  c  •  —  C- 

dt  -J1  -J  -1 


(5.7) 

(5.8) 


Where: 


=  [x}  z;  ]T  :  is  the  position  vector  of  vehicle  i  in  fixed  axis. 

=  [u j  W;  ]T  :  is  the  velocity  vector  of  vehicle  i  in  fixed  axis. 

=  [ax.  az.  J1  :  is  the  target  acceleration  vector  of  vehicle  i  in  fixed  axis, 

y ..  =  [xjj  z  jj  ]T  :  position  vector  of  vehicle  j  w.r.t  i  in  fixed  axis. 

ji  =  [u  ji  w  ji  ]T  :  velocity  vector  of  vehicle  j  w.r.t  i  in  fixed  axis. 

;;  =  a„..  az..  =  c;  -  c;  :  acceleration  vector  of  vehicle  i  w.r.t  i  in  fixed  axis. 

J1  L  xji  zji  J  -J  -i  ’ 


v 

c 

u 


5.2  Constructing  Relative  Sightline  (LOS)  Angles  and  Rates  -  (Rotational 
Kinematics) 

The  separation  range  R  j;  between  vehicles  j  w.r.t  i  is  given  by: 


The  range  rate  R  j;  is  given  by: 
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T 

dK  R  XjiUji+ZjiWji  l-F 

- Kii  —  K;i 


dt 


R 


Ji 


R 


Ji 


(5.10) 


The  Closing  Velocity  VCjj  is  given  by: 


V...  =  -R 


Ji 


(5.11) 


The  sightline  angle  y ;;  of  j  w.r.t  i  is  given  by: 


Ji 


tanyji  = - 

X” 

Differentiating  both  sides  and  simplifying,  gives  us: 


dt 


zjiXji  ZjiXji  XjiWji-ZjiUji 


R 


Ji 


R 


Ji 


R: 


R 


Ji 


(5.12) 


(5.13) 


Note  that  an  approximation  to  (5.13)  is  sometimes  used,  although  not  recommended  for 
simulation  purposes,  based  on  the  assumptions  that  the  engagement  geometry  does  not 
deviate  significantly  from  the  collision  course;  in  this  case: 

Xjj  *  Rjj  =  Vc..Tg0 ;  Xjj  «  Rji  =  -VCj. ;  Tg0  =  (tf  —  t) : is  the  time-to-go. 


Substituting  this  in  equation  (5.13)  gives  us: 
f  ■  \ 


Yji 


1 


Vc- 

cJi 


Zji  ^  Zji 

T  rp  2 

"°  Tgo  J 


(5.14) 


The  measurements  yjj  obtained  from  the  seeker  that  are  used  to  construct  the  guidance 
commands  are  given  by: 

Yji=yji+AYji  (5-15) 


Where: 

Ay  ji  :  seeker  LOS  rate  measurement  error. 

The  above  relationships  (5.9)-(5.15)  will  also  be  referred  to  as  the  seeker  model. 

5.3  Vehicle  Navigation  Model 

Let  us  define  the  following: 

a  :  x-acceleration  achieved  by  vehicle  i  in  its  body  axis. 

:  y-acceleration  achieved  by  vehicle  i  in  its  body  axis. 

The  transformation  from  fixed  to  body  axis  is  given  by  (see  Figure  2): 
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cosGj 

-  sinG; 

3xi 

|rp  b  1 

sinGj 

cosG} 

_ayi_ 

“  lAf  Ji 

aZi 

In  vector/ matrix  notation  this  equation  may  be  written  as: 


(5.16) 


(5.17) 

(5.18) 


Where: 

v|/j :  body  (Euler)  angle  of  the  ith  vehicle  w.r.t  the  fixed  axis. 

iT 

n  I  h  h 

c 


b  =  |^ab.  a*’  J  :  is  acceleration  vector  of  vehicle  i  in  its  body  axis. 
[4  =  [l  fh  ] .  =  [rb  ] .  :  is  the  transformation  matrix  from  body  axis  to  fixed  axis. 


[  fl  cosGj  sinGj 
-sinGj  cosGj 


:  is  the  (direction  cosine)  transformation  matrix. 


The  vehicle  velocity  is  given  by: 

Vi4i2+Wi2)2  4iTVi)2  (5i9) 

The  body  flight  path  angle  is  given  by: 

tan(Gj  -  a,  )=  — 
ui 

Where:  aj  :  is  the  body  angle  of  incidence  angle. 


Differentiating  both  sides  and  simplifying  and  assuming  (as  in  section  2.3)  that  a  j ,  (Xj  are 
small,  we  get: 


dt 


Oi=Gi  = 


U;a, 


w;a. 


VT 


VC 


VC 


(5.20) 


5.4  Vehicle  Autopilot  Dynamics 

Assuming  a  first  order  lag  for  the  autopilot,  we  may  write  for  vehicle  i: 


-a  =  — xv.  a”  +  x. 


dt 

—  ab 
dt  zi 


Wl 


6id 


(5.21) 

(5.22) 


In  vector/ matrix  notation  equations  (5.21),  (5.22)  may  be  written  as: 
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[-Ai]c_r 


■hK 


(5.23) 


Where: 

tx.  :  Vehicle  i  autopilot's  longitudinal  time-constant. 
tz.  :  Vehicle  i  autopilot's  lateral  time-constant. 


ab  :  x-acceleration  demanded  by  vehicle  i  in  its  body  axis. 


*d 


ab  :  y-acceleration  demanded  by  vehicle  i  in  its  body  axis. 


"id 


si- 


x*d 


"id 


:  is  the  demanded  missile  acceleration  (command  input)  vector  in  body 


axis. 


Remarks:  As  in  the  case  of  azimuth  plane  engagement,  the  longitudinal  guidance  commands 
ab  =  — - - -  are  assumed  to  be  zero.  The  effects  of  aerodynamic  forces  under  nominal 


'■d 


m 


flight  conditions  i.e.  ab  = - bgcosG  and  au  = 


— b 


('  -  ■*) 


m 


m 


-  g  sin  0  (see  Appendix  A)  have  to  be 


included  in  the  simulation;  these  are  shown  as:  cb  in  the  block  diagram  Figure  7.  The  limits  on 
the  lateral  acceleration  demanded  can  be  implemented  as  described  in  Appendix  A,  i.e. 
<  u  a, 

“  'max 


abz- 

Zld 


5.5  Guidance  Laws-PN  and  APN  Guidance 

Several  versions  of  the  guidance  laws  derived  in  section  3  for  the  azimuth  plane  engagement 
and  these  extend  directly  to  the  elevation  plane  case.  These  are  briefly  discussed  below: 

5.5.1.  Version  1  (PN-1): 

0id=Nyji  (5.25) 

Where:  N :  is  the  navigation  constant;  and  the  demanded  attacker  lateral  acceleration  is  given 
by: 


-NVifj. 

(5.26) 

b  8T}  -  8D; 

a  — 

(5.27) 

x*d  mj 

5.5.2.  Version  2  (PN-2): 

a“ji  =  VCjitji 

(5.28) 
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"id 


Nanji  =N\CJi  yii 


b  STj-SD; 

d  — 

x*d  m; 


(5.29) 

(5.30) 


Where: 

Vc„  =-Rjj  :  is  the  1  closing  velocity'  between  the  attacker  and  the  target. 

a„ ..  :  is  the  acceleration  normal  to  the  LOS. 

nji 

5.5.3.  Version  3  (PN-3): 

azid  =Nanji  cos(0i  -Yji)=NVcji  cos(0i  -Yjijyji 
ab  _  ST,  -  8Dj 

x*d  mj 


(5.31) 

(5.32) 


5.5.4.  Augmented  Proportional  Navigation  (APN)  Guidance 

Finally,  a  variation  of  the  PN  guidance  law  is  the  APN  that  can  be  implemented  as  follows: 


c?d=(PNG)+N'[Tfb]. 


Sj 


(5.33) 


Where: 

N ' :  is  the  (target)  acceleration  navigation  constant 

(PNG): is  the  proportional  navigation  guidance  law  given  in  (3.1)-(3.7) 

5.6  Overall  State  Space  Model  in  Elevation  Plane 

The  overall  non-linear  state  space  model  (e.g.  for  APN  guidance)  that  can  be  used  for 
sensitivity  studies  and  for  non-linear  or  Monte-Carlo  analysis  is  given  below: 


d 

d.-'r'ii 

(6.1) 

d  Lfl  b  Lfl  b 

dtiji-Mj£j  N.Si 

(6.2) 

d  >/[•']'„ 

dtYjl  y  Ty 

-ji  -ji 

(6.3) 

4={(PNG)+N'[Tfb].?i) 

(6.4) 

(6.5) 

%  e  ^T[j1e' 

dt  '  v.Tv. 

(6.6) 

UNCLASSIFIED 


13 


UNCLASSIFIED 

DSTO-TR-2706 

The  overall  model  that  can  be  implemented  on  the  computer  is  given  in  Table  5.1.  and  the 
block-diagram  is  shown  in  Figure  7. 


6.  Conclusions 


In  this  report  mathematical  models  are  derived  for  multi-vehicle  guidance,  navigation  and 
control  model  suitable  for  developing,  implementing  and  testing  modern  missile  guidance 
systems.  The  models  allow  for  incorporating  changes  in  body  attitude  in  addition  to  autopilot 
lags,  accelerometer  limits  and  aerodynamic  effects.  These  models  will  be  found  to  be 
particularly  suitable  for  studying  the  performance  of  both  the  conventional  and  the  modern 
guidance  such  as  those  that  arise  of  game  theory  and  intelligent  control  theory.  The  following 
are  considered  to  be  the  main  contribution  of  this  report: 

•  The  models  are  derived  for  Az  as  well  as  the  El  plane  engagements  for  multi-vehicle 
engagement  scenarios, 

•  The  models  incorporate  non-linear  effects  including  large  changes  in  vehicle  body 
attitude,  autopilot  lags,  acceleration  limits  and  aerodynamic  effects, 

•  The  models  presented  in  this  report  can  easily  be  adapted  for  multi-run  non-linear 
analysis  of  guidance  performance  and  for  undertaking  Monte-Carlo  analysis. 
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Table  1:  Combined  (Yaw-Plane)  State  Space  Dynamics  Model  for  Navigation,  Seeker,  Guidance  and 
Autopilot 
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Table  2:  Combined  (Pitch-Plane)  State  Space  Dynamics  Model  for  Navigation,  Seeker,  Guidance  and 
Autopilot 
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Figure  3:  Body  Incidence 


Figure  4:  Axis  System  Convention 
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Appendix  A 


A.l  Aerodynamic  Forces  and  Equations  of  Motion 

For  a  symmetrical  body(lzx  =  0;  Iy  =IZ  J,  the  equations  of  motion  for  an  aerodynamic 
vehicle  are  given  by  (see  Figure  Al.l)  [4]: 

iib  +  qwb  -  rvb  =  —  -  g sin  0  (A-l.l) 


vb  +  rub  -pwb  =  — +  gcos0sin(|) 
m 

wb  +pvb  -qub  =  —  +  gcos0cos<j) 


p  +  qr 

q  +  rp 

r +  pq 


(jz  *y ) 


lx 

(ix-Iz) 

lx 

M 

Iv 

U 

y 

y 

('y-'d. 

_  N 

Iz 

X 

(A-l-2) 

(A-1.3) 

(A-1.4) 

(A-1.5) 

(A-1.6) 


Where: 

(ub ,  vb ,  wb  j:  are  the  vehicle  velocities  defined  in  body  axis. 

(p,q,r):  are  the  body  rotation  rates  w.r.t  the  fixed  axis  defined  in  the  body  axis. 

(x,  Y,z):  are  the  aerodynamic  forces  acting  on  the  vehicle  body  defined  in  the  body  axis. 
(l,  M,  n)  :  are  the  aerodynamic  moments  acting  on  the  vehicle  body  defined  in  the  body  axis. 
(lx  ,Iy  ,IZ  J:  are  the  vehicle  body  inertias, 
m :  is  the  vehicle  mass. 

(v|/,  0,  §) :  are  respectively  the  body  (Euler)  angles  w.r.t  the  fixed  axis. 

For  a  non  rolling  vehicle  p  =  p  =  c(>  =  0 ;  this  assumption  enables  us  to  decouple  the  yaw  and 
pitch  kinematics.  Equations  (A-1.1)-(A1.6)  give  us: 


iib  +qwb  - rvb  =  —  -gsin0 

(A-1.7) 

m 

yb+rub=X 

(A-1.8) 

m 

b  j,  Z 

w  -  qu  = - h  geos 0 

(A-1.9) 

m 

L  =  0 

(A-1.10) 

M 

(A-l.ll) 

qx 

y 

N 

r  =  — 

I, 

(A-1.12) 
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The  accelerations  about  the  vehicle  body  CG  is  given  by: 

ab  =ub  +qwb  -rvb  =  — -gsinG 

m 


a 

a 


b 

y 

b 

z 


=  vb  +  rub 


m 


+  gCOS0 


(A-1.13) 

(A-1.14) 

(A-1.15) 


Where:  (ab,ab,ab 


):  are  the  body  accelerations  w.r.t  the  fixed  axis  defined  in  the  body  axis. 


If  we  consider  perturbation  about  the  nominal,  we  get: 

ab  +  Sab  =  +  -  g  (sin  0  +  cos  0  80) 

m 

m 

ab  +  8  ab  =  +  +  g  (cos  0  -  sin  0  80) 

m 


A.2  2-D  Yaw-Plane  Kinematics  Equations: 


For  2-D  yaw-plane  kinematics  only  0  =  0;  80  =  0  (i.e.  zero  pitch  motion),  therefore,  the  X 
and  Y-plane  steady  state  equations  (in  body  axis)  may  be  written  as: 


a  b  =  —  =  Y 

J  m 


mm 


Where  we  define: 


m 


=y; 

mm 


(A-1.16) 

(A-1.17) 

Also,  the  total  thrust  is  defined  as: 


T  =  T  +  8T ,  and  the  total  drag  is  defined  as:  D  =  D  +  8D . 


For  'nominal  flight'  condition  in  the  yaw-plane  Y  =  0 ;  and  the  perturbation  equation  is  given 
by: 


m 


8a.  =  8X  =  (6T-8D)  =  (5f-55) 

m  m  v  7 


(A-1.18) 

(A-1.19) 


Where  : 

8ab  represents  the  body  axis  guidance  commands  (lateral  acceleration)  applied  by  the 
vehicle. 


UNCLASSIFIED 


23 


UNCLASSIFIED 

DSTO-TR-2706 

5  a!)  :  represents  the  body  axis  guidance  commands  (longitudinal  acceleration)  applied  by  the 
vehicle.  However,  during  guidance  manoeuvre  (sT,  SL))  are  not  directly  controlled.  Hence  we 
may  assume  8  a!)  to  be  zero. 


A.3  2-D  Pitch-Plane  Kinematics  Equations: 


Unlike  the  previous  case,  for  2-D  pitch-plane  kinematics  0*0,  and  for  steady  state 
conditions,  we  get: 


z  _  ~  _ 

a  ”  = - h  g  cos  0  =  Z  +  g  cos  0 

m 


a£  =  —  -  g  sin  0  =  ^  -  g  sin  0  =  (t  -  d)-  g  sin  0 

m  m 


(t-p) 


(A-1.20) 

(A-1.21) 


The  X ,  Z  (pitch)-plane  perturbation  kinematics  (in  body  axis)  is  given  by: 


8a*)  =  —  =  SZ 


m 


8a 


b  (5T-8P) 


m 


(8T  -  8d) 


(A-1.22) 

(A-1.23) 


Where 

8  a  J)  :  represents  the  body  axis  guidance  commands  (lateral  acceleration)  applied  by  the 
vehicle. 


As  in  the  case  of  the  yaw-plane,  during  guidance  (ST,  8d)  are  not  directly  controlled,  hence 
we  may  assume  8a!)  to  be  zero.  The  reader  will  recognize,  that  in  the  main  text  of  this  report: 


a"  =  8  a  x ,  a  =  8  a .  a  =  8  a, 

xd;  X  Yd;  y  zd;  2 


(A-1.24) 


A.4  Calculating  the  Aerodynamic  Forces 


For  the  purposes  of  the  simulation  under  consideration  we  may  assume  that  the  vehicle 
thrust  profile  T(t) ,  say  as  a  function  of  time,  is  given;  then  the  drag  force  D ,  which  depends  on 
the  vehicle  aerodynamic  configuration,  is  given  by: 


D  = 

Y  = 

Z  = 


^pv2s 

V2 

^pv2s 

V2 


CD(a,p) 

cL(p)=o 


V2S  CL(a)  =  -gcos0 


(A1.25) 

(A1.26) 

(A1.27) 


Where:  the  term  in  the  bracket  is  the  dynamic  pressure;  p  being  the  air  density,  S  is  the  body 
characteristic  surface  area  and  V  is  the  steady-state  velocity.  C  D  is  the  drag  coefficient  and 
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Cl  is  the  lift  coefficient,  (a,  p)  represent  respectively  the  pitch-  and  the  yaw-plane  nominal 
(steady-state)  incidence  angles.  Contribution  to  thrust  and  drag  due  to  control  deflections  are 
small  and  ignored.  Also: 
f  i  A 

“  (A1.28) 


5Y  = 


SZ  = 


TPV^S 

vz 

hpv^s 


cL(sp)=o 

C  L  (8a)  =  -g  sin  0  80 


(A1.29) 


(8a,  8p)  represent  respectively  the  the  variation  in  pitch-  and  the  yaw-plane  incidence  angles 
as  a  result  of  control  demands;  these  are  assumed  to  be  small. 


Note  that  for  a  given  (8a,  8p),  5Y,  8Z  cc  V2 ,  the  maximum/ minimum  acceleration  capability 

of  a  vehicle  is  rated  at  the  nominal  velocity  V ,  then  the  maximum/ minimum  acceleration  at 
any  other  velocity  V  is  given  by: 


ab 

<  p  ab  ; 

ab 

ya 

Ymax 

zd 

;Where:  p  = 


2 


A.5  Body  Incidence 


The  body  incidence  angles  (a, p)  are  given  by  (v  h ,  w  b  «  u  h ) : 


a  =  tan 


-1 


(  wb 


W  I 


vb 

‘^;vb 


:  V : 


111 
+  vb  +Wb 


;  these  angles 


represent  the  angle  that  the  body  makes  w.r.t  'flight  path'  or  with  the  direction  of  the  total 
velocity  vector  V .  In  this  report  we  shall  assume  that  these  angles  are  small  and  may  be 
ignored;  in  which  case  the  body  can  be  assumed  to  be  aligned  with  the  velocity  vector. 


UNCLASSIFIED 


25 


Page  classification:  UNCLASSIFIED 


DEFENCE  SCIENCE  AND  TECHNOLOGY  ORGANISATION 
DOCUMENT  CONTROL  DATA 


1.  PRIVACY  MARKING/ CAVEAT  (OF  DOCUMENT) 


2.  TITLE  3.  SECURITY  CLASSIFICATION  (FOR  UNCLASSIFIED  REPORTS 

THAT  ARE  LIMITED  RELEASE  USE  (L)  NEXT  TO  DOCUMENT 
Integrated  Navigation,  Guidance,  and  Control  of  Missile  Systems:  CLASSIFICATION) 

2-D  Dynamic  Models 

Document  (U) 

Title  (U) 

Abstract  (U) 


4.  AUTHOR(S) 
Farhan  A.  Faruqi 


6a.  DSTO  NUMBER 
DSTO-TR-2706 


5.  CORPORATE  AUTHOR 


DSTO  Defence  Science  and  Technology  Organisation 
PO  Box  1500 

Edinburgh  South  Australia  5111  Australia 


6b.  AR  NUMBER 
AR-015-302 


6c.  TYPE  OF  REPORT 
Technical  Report 


7.  DOCUMENT  DATE 
May  2012 


8.  FILE  NUMBER 

9.  TASK  NUMBER 

10.  TASK  SPONSOR 

11.  NO.  OF  PAGES 

12.  NO.  OF  REFERENCES 

2012/1001675 

n/a 

CWSD 

19 

6 

DSTO  Publications  Repository 

http:/ / dspace.dsto.defence.gov.au/dspace/ 


15.  SECONDARY  RELEASE  STATEMENT  OF  THIS  DOCUMENT 


14.  RELEASE  AUTHORITY 
Chief,  Weapons  Systems  Division 


Approved  for  public  release 


OVERSEAS  ENQUIRIES  OUTSIDE  STATED  LIMITATIONS  SHOULD  BE  REFERRED  THROUGH  DOCUMENT  EXCHANGE,  PO  BOX  1500,  EDINBURGH,  SA  5111 _ 

16.  DELIBERATE  ANNOUNCEMENT 

No  Limitations 

17.  CITATION  IN  OTHER  DOCUMENTS  Yes 

18.  DSTO  RESEARCH  LIBRARY  THESAURUS 

Modelling;  Missile  Guidance;  Missile  control 

19.  ABSTRACT 

In  this  report  mathematical  models  (2-D  Azimuth  and  Elevation  Planes)  for  multi-party  engagement  kinematics  are  derived  suitable  for 
developing,  implementing  and  testing  modern  missile  guidance  systems.  The  models  developed  here  are  suitable  for  both  conventional  and 
more  advanced  optimal  intelligent  guidance  schemes  including  those  that  arise  out  of  the  differential  game  theory.  These  models 
accommodate  changes  in  vehicle  body  attitude  and  other  non-linear  effects  such  as  limits  on  lateral  acceleration  and  aerodynamic  forces. 


Page  classification:  UNCLASSIFIED 


